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(54) POSITION CONTROLLER 

(57) A position controller which controls the position 
of a motor comprising a position control unit (12) which 
controls the position of the motor so that the position of 
the motor may agree with the position command of a 
command generator (11), a speed control unit (13) 
which outputs a torque command and controls the 
speed of the motor so that the speed of the motor may 
agree with the speed command of the position control 
unit (12) and a current control unit (14) which controls 
the current applied to the motor in accordance with the 
command of the speed control unit (13). The speed con- 
trol unit (13) has a speed feedback filter (131) by which 
the speed is applied to a low-pass filter, a subtracter 
(132) which subtracts the signal of the speed feedback 



filter (131) from the speed command to obtain a speed 
deviation, an integrator (133) which integrates the 
speed deviation with respect to time to obtain an inte- 
grated speed deviation value, a multiplier (136) which 
multiplies the speed command by a coefficient a. an 
adder/subtracter (135) which adds the signal of the mul- 
tiplier to the integrated speed deviation value and, fur- 
ther, subtracts the speed from the sum, a multiplier 
(136) which multiplies the output of the adder/subtracter 
by a speed loop gain Kv and a torque filter (139) which 
applies the signal of the multiplier (136) to a low-pass fil- 
ter. 
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Description 
TECHNICAL FIELD 

[0001 1 The present invention relates to a position con- 
troller for motors, robots, machine tools, etc., and in par- 
ticular to a position controller for which a high speed 
response is required. 

BACKGROUND ART 

[0002] As a position controller aiming at a high speed 
response, for example, a position controller is available, 
which is provided with a command generator for gener- 
ating position instructions, a position control unit for 
controlling a position by inputting a position instruction 
and the position of a motor being an object to be control- 
led, and outputting a speed instruction so that they 
become coincident with each other, a speed control unit 
to control a speed by inputting a speed instruction and a 
speed of the motor, and outputting a torque instruction 
so that they become coincident with each other, and a 
current control unit for controlling a current on the basis 
of the inputted torque instruction, and further provided 
with a subtracter which obtains a speed deviation by 
subtracting the speed from the speed instruction, an 
integrator which obtains an integral figure ot the speed 
deviation by time-integrating the speed deviation with a 
time constant Ti, a multiplier for multiplying the speed 
instruction by a (0.0 ^ a ^ 1 .0), an adder and subtracter 
which adds a signal of the multiplier to an integral figure 
of the speed deviation and at the same time subtracts 
the speed therefrom, multiplier for multiplying an output 
of the adder and subtracter speed bop gain, and a 
torque filter for filtering a signal of the multiplier through 
a low-pass filter and making it into a new torque instruc- 
tion. 

[0003] However, there is such a problem by which in 
cases where the speed loop gain is increased or where 
the time constant Is shortened, the control system itself 
may be likely to vibrate by delay of the torque filter con- 
sisting of a low-pass filter secured to suppress vibra- 
tions induced by the mechanical system. 

DISCLOSURE OF INVENTION 

[0004] It is therefore an object of the invention to pro- 
vide a position controller to solve the problem. A posi- 
tion controller according to the first claim of the 
invention has a command generator for generating posi- 
tion instructions, a position control unit for controlling a 
position by inputting a position instruction and the posi- 
tion of a motor being an object to be controlled, and out- 
putting a speed instruction so that they become 
coincident with each other, a speed control unit for con- 
trolling a speed by inputting a speed instruction and a 
speed of the motor and outputting a torque instruction 
so that the speed Instruction and speed become coinci- 



dent with each other, and a current control unit for con- 
troliing a current on the basis of the torque instruction, 
wherein the speed control unit is provided with a speed 
feedback fitter which obtains a new speed of a motor by 

5 filtering the speed through a low-pass filter, a subtracter 
which obtains a speed deviation by subtracting the new 
speed from the speed instruction, an Integrator which 
obtains an integral figure of the speed deviation by time- 
integrating the speed deviation by a time constant Ti. a 

10 multiplier which multiplies the speed instruction by a 
(0.0 ^ a ^ 1.0), an adder and subtracter which adds a 
signal of the multiplier to the integrated figure of the 
speed deviation and subtracts the speed therefrom, a 
multiplier which calculates a torque instruction by multi- 

15 plying the output of the adder and subtracter by a speed 
loop gain kv, and a torque filter which makes a torque 
instruction into a new torque instruction by filtering it 
through a low-pass filter. 

[0005] A position controller according to the second 

20 daim of the Invention is featured in that the position con- 
trol unit is provided with a speed feed forward device 
which multiplies the position instruction by a speed feed 
forward constant FF (0.0 ^ FF ^ 1.0) after differentiating 
the position instruction by time, and an adder which 

25 obtains a new speed instruction by adding a signal of 
the speed feed forward device to the speed instruction. 
[0006] A position controller according to the third claim 
of the invention is featured In that the speed control unit 
Is provided with a torque feed forward device which dif- 

30 ferentiates the speed instruction by time and makes It 
(motor inertia + load inertia) -fold, and multiplies it by the 
torque feed forward constant FFa (0 ^ FF ^ 1), and an 
adder which obtains a new torque Instruction by adding 
a signal of the torque feed forward device to the signal 

35 of the multiplier. 

BRIEF DESCRIPTION OF THE DRAWINGS 
[0007] 

40 



FIG. 1 is a block diagram of a motor control 
system to which the present Invention is 

45 applied; 

FIG. 2 is a view showing the details of a posi- 
tion control unit in FIG. 1 ; 
FIG. 3 Is a view showing the details of a speed 
control unit in FIG. 1 ; and 

50 FIGS. 4 are views showing examples of actions 

where a one-axis roller slider is driven by using 
the present invention. 

BEST MODE FOR CARRYING OUT THE INVENTION 

55 

[0008] FIG. 1 is a block diagram of a motor controlling 
system to which the present invention is applied. A com- 
mand generator 1 1 outputs a position instruction Pref. 
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The position control unit 12 carries out position control 
by inputting the position instruction Pref and a position 
Pf b of a motor 1 5. which is detected by a detector 1 6. so 
that the position instruction Pref becomes coincident 
with the position Pfb. and outputs a speed Instruction 5 
Vref. A speed control unit 13 carries out speed control 
by inputting the speed instruction Vref and a speed Vfb 
of the motor, which is obtained by a differentiator 1 7 tak- 
ing a differential of the position Pfb. so that the speed 
instruction Vref and speed Vfb become coincident with ^0 
each other, and outputs a torque instruction. A current 
control unit 14 outputs a current In response to a torciue 
instruction Tref by inputting the torque instruction Tref 
and drives the motor 15. 

[0009] And. the speed of the motor 1 5 is controlled by is 
a speed control loop consisting of the speed control unit 
13. current control unit 14. motor 15, detector 16 and 
differentiator 1 7, so that the motor 1 5 rotates at a speed 
rate responsive to a speed instruction Vref of the posi- 
tion control unit 12. Further, by a position control loop in 20 
which a position control unit 12 is added to the speed 
control loop, the position of the motor 1 5 is controlled so 
that the rotation position of the motor 15 becomes 
responsive to a position Instruction Pref of the com- 
mand generator 1 1 . 

[001 0] FIG. 2 is a view showing details of the position 
control unit 12. The position control unit 12 consists of a 
subtracter 121 which obtains a position deviation Pe by 
inputting the position instruction Pref and motor position 
Pfb and subtracting the motor position Pfb from the 30 
position Instruction Pref, a multiplier 122 which outputs 
the speed instruction Vref by making the position devia- 
tion Pe position loop gain Kp fold, a speed feed forward 
device 123 which obtains a speed feed fonward signal 
FFdPr by differentiating the position instruction Pref by 35 
time and multiplying It by a speed feed fbnward constant 
FF (0 s FF s 1.0). and an adder 124 which adds a 
speed feed fonward signal FFdPr to the speed instruc- 
tion Vref and makes a new speed instruction Vref. 
Thereby, the the position control unit 12 outputs the 4o 
speed Instruction Vref to the speed control unit 13. 
1001 1 ] FIG. 3 is a view showing details of the speed 
control unit 13. The speed control unit 13 consists of a 
speed FB filter 131 which obtains a speed FVfb by 
inputting a speed instruction Vref and a speed Vfb and 4s 
filtering the speed Vfb through a low pass filter, a'sub- 
tracter 132 which obtains a speed deviation Ve by sub- 
tracting the speed FVfb from the speed Instruction Vref, 
an integrator 133 which obtains an Integrated figure SVe 
of the speed deviation by time-integrating the speed so 
deviation Ve by a time constant Ti, a multiplier 134 
which obtains a proportional signal a Vref by multiplying 
the speed instruction Vref by a (0.0 ^ a ^ 1 o) an 
adder/subtracter 1 35 which adds the proportional signal 
a Vref to the Integrated figure SVe of the speed devia- ss 
tion and subtracts the speed Vfb therefrom, a multiplier 
136 which calculates a torque Instruction Tref by multi- 
plying an output of the adder/subtracter by a speed loop 



gain Kv. a torque feed fonward device 137 which differ- 
entiates the speed instruction Vref by time, makes J J- 
fbld as the sum of motor inertia and load Inertia, multi- 
plies it by the torque feed fonward constant FFa (0 ^ FFa 
^ 1. 0), and outputs a torque feed forward signal 
FFadVr, an adder 138 which makes a new torque 
instruction Tref by adding the torque feed forward signal 
FFadVr to the torque instruction Tref. and a torque filter 
1 39 which creates a new torque instruction Tref by filter- 
ing the torque Instruction Tref through a low pass filter. 
Thereby, the speed control unit 13 outputs a torque 
instruction Tref to the current control unit 14. 
[001 2] FIGS. 4 are views showing examples of actions 
where a one-axis roller slider Is driven by using the 
present invention, wherein, as shown In a conventional 
example, (a) shows a state wherein a torque filter is 
employed in order to suppress vibrations. P (propor- 
tional) control is adopted for position control, and 1-P 
(integration proportion) control (a = 0) is adopted for 
speed control. In addition, speed feed fbnward and 
torque feed fonward are not employed ( FF = FFa - 0 ). 
and (b) shows a state where a response according to 
the present invention is employed which is such that a 
speed FB filter is added to the conventional example. 
The control parameters of the present invention are the 
same as those in the conventional example, wherein the 
position loop gain Is Kp = 200rad/s, speed loop gain Is 
Ky = 200Hz. time constant of speed loop integration is 
Ti = 1.56ms, and torque filter is Tf = 0.4ms. However, 
the preferred embodiment of the invention is provided 
with a speed FB filter, and the time constant becomes 
Tk = 0.4ms. As has been made clear from the drawings, 
overshoot arises when positioning in the conventlonai 
example. Kv may be Increased or Ti may be shortened 
in order to eliminate the overshoot. However. Kv and/or 
Ti cannot be adjusted anymore because vibrations 
occur. In addition, although the overshoot can be elimi- 
nated by lowering Kp. the positioning time may be 
lengthened. On the other hand, in the preferred embod- 
iment of the invention, a high speed positioning can be 
achieved without making any overshoot. Further. In the 
drawing, Pref Indicates a position Instruction. Pfb indi- 
cates a motor position. Pe Indicates a position deviation. 
Pe' Indicates enlargement of Pe. and Tref indicates a 
torque instruction. 

INDUSTRIAL APPLICABILITY 

[001 3J As described above, according to the invention, 
since the speed control unit is provided with a speed FB 
filter, the control system itself does not vibrate even 
though the speed loop gain is increased or the time con- 
stant is shortened, wherein a quick reach at an objective 
position can be achieved. Therefore, it is possible to 
provide a position controller which has high perform- 
ance and useful applicability. 
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Claims 

1 . A position controller for corYtrolling a motor position, 
comprising: 

a command generator lor generating a position 

instruction; 

a position control unit for controlling a position 
by Inputting a position instruction and a motor 
position being an object to be controlled and 
outputting a speed instruction so that they 
become coincident with each other; 
a speed control unit for controlling a speed by 
inputting a speed instruction and a speed of 
said motor and outputting a torque instruction 
so that they become coincident with each 
other; and 

a current control unit for controlling a current on 
the basis of the torque instruction; 
wherein said speed control unit comprises; 



3. A position controller as set forth in Claim 2. wherein 
said speed control unit comprises: 

a torque feed forward device for differentiating 
5 the speed Instruction by time, making it (motor 

inertia + load inertia) -fold, and multiplying it by 
a torque feed fonward constant FFa {(0 ^ FFa ^ 
1); and 

10 an adder which obtains a new torque instruc- 

tion by adding a signal of the torque feed for- 
ward device to the signal of said multiplier. 



a speed feedback filter which obtains a 
new speed of a motor by filtering the speed 
through a low-pass filter; 
a subtracter which obtains a speed devia- 25 
tion by subtracting the new speed from the 
speed instruction; 

an integrator which obtains an integrated 
figure of the speed deviation by time-inte- 
grating the speed deviation by a time con- 30 
stant Ti; 

a multiplier for multiplying the speed 
instruction by a coefficient a (0.0 ^ a ^ 
1.0): 

an adder and subtracter which adds an 3s 
integrated figure of the speed deviation to 
a signal of the multiplier and subtracts the 
speed therefrom; 

a multiplier for multiplying the output of the 
adder/subtracter by a speed loop gain Kv 40 
and for calculating a torque instruction; 
and 

a torque filter for making a new torque 
instruction by filtering the torque instruc- 
tion through a low-pass filter. 45 

2, A position controller as set forth in Claim 1 , wherein 
said position control unit comprises; 

a speed feed forward device for differentiating a so 
position instruction by time and multiplying it by 
a speed feed fonward constant FF (0.0 ^ FF ^ 
1.0); and 



an adder which obtains a new speed Instruc- ss 
tion by adding a signal of the speed feed for- 
ward device to the speed instruction. 
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Fig. 2 
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Fig. 3 
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Fig. 4a 
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Fig. 4b 
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